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ABSTRACT 



In future space missions it is planned that an un- 
manned robot will be sent to explore the other planets’ 
surface. Control of the vehicle from earth is unrealistic 
because of the long delay time in the transmission of data. 
From a gross knowledge of the terrain a global routing al- 
gorithm can be used to find an optimal path from one point 
to another. A survey was undertaken to find an algorithm 
best suited for this use. Dynamic programming was select- 
ed and in combination with Lim's path-finding algorithm 
proved to be successful in simulated vehicle explorations 
over terrain represented by Gaussian density functions. 
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I. 



INTRODUCTION 



With man's first step on the moon it becomes increas- 
ingly apparent that future missions will carry him to the 
other planets in the solar system. It is anticipated that 
preceding man's exploration of these other planets some 
kind of unmanned robot will be sent to carry out a prelim- 
inary investigation. Because of the long time delays in 
the transmission of data it will be necessary to have the 
robot maneuver itself on the surface, using a computer 
that is onboard or in an orbiting satellite. Prior to 
placing the robot on the planet, various orbital reconnais- 
sances will be made and a gross knowledge of the topography 
of the planet will be available. 

From this knowledge a landing site can be chosen and 
the interesting target areas to be visited can be deter- 
mined. A pathfinding procedure that can be used to maneuver 
the robot over the terrain and around hazards has been de- 
veloped (Ref. L-2) . This computational procedure, called 
the local algorithm, uses only onboard sensor information 
and hence may generate paths which are inefficient in terms 
of elapsed time, consumed energy, or distance 
To compensate for this deficiency, a nominal path can be 
found by a routing algorithm that uses the knowledge avail- 
able from photoreconnaissance data (Ref. K-2) . The robot 
follows the nominal path which has been programmed into the 
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computer. By using local sensory information the robot 
proceeds along the nominal path until it detects a hazard. 
The robot then switches to the local path-finding algorithm 
that uses only local sensory information to proceed around 
the hazard. 

A study of several routing algorithms was undertaken 
and the results are contained in Chapter II. Chapter III 
gives the development of the local path-finding algorithm. 
In order to show the combined operation of the two routing 
algorithms, a means of simulating suitable terrain was de- 
vised -- this is also contained in Chapter III as well as 
the results of a number of simulations. Combined operation 
of the global and local algorithms proved to be feasible. 



II . ROUTING ALGORITHMS 



A. INTRODUCTION 

Assume that it is desired to find the shortest path 
between two cities on a map. For a simple map the solution 
is trivial. As the number of cities on the map increases, 
the calculations become tedious. Without knowledge of 
routing algorithms the task becomes insurmountable. 

Routing algorithms have found many uses other than 
finding the shortest route across a map. The telephone com- 
panies have used such algorithms extensively in trunk cir- 
cuits. If a particular trunk circuit is busy, the circuit- 
ry will endeavor to find the next shortest trunk circuit 
between the cities being called. Industries in the produc- 
tion of consumer commodities make use of routing algorithms 
in their assembly lines. If a particular section of the 
assembly is inoperative, or in need of repair, the product 
is routed to another assembly line where the other com- 
ponents can be put on the article. This makes the most 
efficient use of the total assembly plant. Once a product 
is produced it must be shipped. The best and fastest ship- 
ping routes are calculated by the use of routing algorithms. 

It is intended that the algorithms presented will show 
just how the optimal paths or procedures can be found. The 
methods presented require no foresight or ingenuity and 
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thus deserve to be defined as algorithms. They can easily 
be used in a machine, either a special purpose or general 
purpose digital computer. 

In the execution of the algorithms, the particular 
costs, either between cities, or between nodes, or along a 
trunk circuit, can be arrived at by determining the time to 
travel between two points, or the total distance travelled. 
The cost can also include the amount of energy used, or may 
be a combination of any of these factors. 

B. DYNAMIC PROGRAMMING 

A very useful type of routing algorithm is based on 
dynamic programming. Dynamic programming, as developed by 
R. E. Bellman (Refs. B-1, B-2) , is a technique of optimal 
control as well as a routing algorithm. In formulating any 
optimal problem a performance measure or cost must be es- 
tablished. 

When applying dynamic programming the performance 
measure may include penalties for not reaching the final 
point. In the case of routing, the final point must be 
reached so that the cost is infinite for not reaching the 
end point. The performance measure can include the amount 
of time spent or the fuel consumed by the vehicle. These 
costs may be summed over the entire journey or only parts 
of it. More importance may be given to the amount of fuel 
used than to the time spent. In addition, dynamic 
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programming can be applied to allocation problems. In al- 
location problems it is desired to maximize the value of 
the cargo stored in a specified amount of space. 

In the case of routing, the cost placed in the perform- 
ance measure is usually the distance travelled. This dis- 
tance can be calculated for both two-dimensional and three- 
dimensional Euclidean surfaces. Costs for time and energy 
spent in travelling across these surfaces can also be used. 

In dynamic programming, the principle of optimality 
(Refs. B-1, K-1) is used to find the optimal route. For 
example, if the costs of going from city to city are as 
shown in Fig. (2.1), the optimal path from Miami to New 
York goes through Atlanta and Washington. The cost for 
this route is 19. Because the segment from Washington to 
New York is part of the optimal path, it is also optimal 
from Washington to New York. Bellman (Ref. B-3) has called 
the above property the principle of optimality: 

"An optimal policy has the property that whatever the 
initial state and initial decision are, the remaining deci- 
sions must constitute an optimal policy with regard to the 
state resulting from the first decision." 

To illustrate this principle suppose that the optimal 
route from Washington to New York passes through Columbus. 
This says that the optimal path from Miami to New York 
passes through Columbus and it is easily seen that this is 
not the case; the cost from Washington to Columbus to New 
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Fig. 2.1 Illustration of the principle of optimality. 
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York is 49, compared to 9 from Washington to New York. The 
path from Miami which includes Columbus is longer than the 
one that goes straight from Washington to New York. This 
violates the condition that the path including Columbus is 
the optimal path; therefore, the optimal path goes from 
Miami through Atlanta and Washington to New York. By the 
principle of optimality the route from Washington directly 
to New York is optimal. 

Let (X^, Y^) i = 1,2, ,N be the coordinates of a 

set of N points on a plane. Let the cost of moving from 
the point L, / to the point M, , along the 

straight line joining these two points be designated tj^. 
Assume that t^^ has been calculated for all L, M = 1,2,...N 
and that 



The problem is to find a minimum-cost path, specified 
by a sequence of nodes, that is to be travelled from some 
initial point L to some specified end point M. This path 
will be designated the optimal path from L to M. 

From the principle of optimality (Refs. B-1, K-1) the 
functional recurrence equation 



> 0 L 7^ M 



t 



LM 



L,M = 1,2, .. .N 



( 2 . 1 ) 



0 L = M 




min < 



( 2 . 2 ) 
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is obtained. is the optimal or minimum cost of moving 

from node L to M. The number of intermediate points on the 
optimal path cannot exceed N-2, because this indicates that 
there is a loop in the path, and by eliminating the loop a 
smaller cost would result. 

The initial conditions for Eq. (2.2) are 

= 0 , L = 1,2, . . .N (2.3) 

Picard's method of successive approximations can be 
used to solve Eq. (2.2); this approach leads to the equa- 
tion 



c 

LM 



min 

J\ ^ Li 



1,2 



.N (2.4) 



with the initial value 



'LM 



= t 



LM 



L,M = 1,2,.. .N. 



(2.5) 



The successive approximations have the following in- 
terpretation : 

1. c^, ° is the minimum cost to go from L to M via no 

LM ^ 

intermediate nodes; 



2 . 



c 




min 

IhK + =KM°t 



( 2 . 6 ) 



or 



min 

K. Li 
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is the minimum cost to go from L to M via at most one in- 
termediate node; 



3. 



c 



LM 




(2.7) 



is the minimum cost to go from L to M via at most j+1 in- 
termediate nodes. 



column of the C matrix) are needed. The solution is ob- 



to find the minimum value of K. 

After the minimizing value of K is calculated, the cost 
associated with this K is stored as the LM element of the C 
matrix. The dimensions of the matrix are depedent on the 
nvunber of nodes; therefore, the C matrix is an N by N 
square matrix. 

After finding the minimizing value of K, this value is 
also stored in the LM position of the node matrix N. Once 
the iterative process has terminated, the node matrix can 
be used to find the intermediate nodes along the optimal 
path from L to M. 

The use of this algorithm is best seen by an example. 

On the map in Fig. (2.2) the costs between cities are 
shown. The costs are not the actual distances, but are ar- 
bitrary numbers picked at random for this example. In some 



To solve for » Kt^L, K = 1,2,...N (the Lth 

row of the T matrix) and c^ Kj^M, K = 1,2,...N (the Mth 



tained by comparing the values t_„ + c ^ for K = 1,2 



f • • • 
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cases there are no direct paths between cities. Where 
there is no direct connection, the cost between the two 
cities was set at 500. This cost is large enough to pre- 
vent the algorithm from selecting the direct path between 
the two cities. In Table II. la the T matrix was solved for. 
Due to the large number of nodes only a section of the map 
was used in this example. Table II. lb shows the section 
of the T matrix that was used. Because only a section of 
the total T matrix was used, the optimal paths calculated 
in the example may differ from those calculated by using 
the entire T matrix. 

Set C° = T for the successive approximation Eq. (2.4) . 
To solve for the first row of the matrix, the first 
calculation is: 





t + c^ 

37 74' 




min |l0 + 0, 500 + 22,500 + 500, 



500 + 25,23 + 500l- = 10 
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Fig. 2.2 



The costs between cities. 
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Table II. la The Entire Cost Matrix for Fig. 
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FRANCISCO 



and the element of the node matrix is n^^ = 4. The 

next step gives; 



c 



1 

35 



and n^g = 



min 


1*^34 ^^ 45 ' 


^35 ^55 


*^36 


*^65' *^37 


*^75' ^38 


min 


|l0 + 22,500 


+ 0,500 


500 


+ 15,23 + 55 


} = 32 



4. 




34, 



} 



This process continues until all of the elements in 
the row are calculated; then the remaining rows are calcu- 
lated in a similar manner. 

A second iteration was carried out in the manner pre- 

1 2 

scribed. Since the C and C matrices were not the same 

(Table II. 2), a third iteration was carried out. After the 

third iteration there were no changes in the cost and node 

2 2 

matrices, so the solution yielded C and N (Table II. 3) as 
the optimal cost and node matrices. 

In order to see how to use the optimal node matrix, 
suppose that it is desired to travel from New York (6) to 
Indianapolis (8). Looking up n^g (see Table II. 3) it is 
found that 7 is the first intermediate point. By looking 
up the 7,8 element in the node matrix, 4 is found to be the 
first intermediate node on the optimal path from 7 to 8, 
and the second intermediate node on the optimal path from 
6 to 8. The 4,8 element is 3 and this becomes the third 
intermediate node. The 3,8 element of the node matrix is 
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Table II. lb 

The Cost Matrix for the Dynamic Programming Example 
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found to be the final point 8. By the principle of opti- 
mality n,o includes 7, 4, and 3; therefore the optimal path 

O O 

is 6-V-4-3-8. 

The dynamic programming approach requires storage for 
two matrices whose dimensions depend on the number of points 
or nodes. This may mean a great deal of storage for a 
single problem, but this is compensated for by the small 
number of calculations. 

C. DANTZIG’S SHORTEST-ROUTE ALGORITHM 

George B. Dantzig (Ref. D-1) has applied linear pro- 
gramming methods for the solution of discrete-variable ex- 
tremum problems to obtain two routing algorithms. Dantzig 's 
algorithms have been used in routing telephone calls, in 
circuit analysis and in shipping, but because of the many 
calculations and large storage requirements have proven to 
be of limited value. 

As in dynamic programming, the costs are arrived at by 
considering the time taken, or the distance travelled, or 
the energy used to get from one point to another. For ex- 
ample, using the same map as in the dynamic programming 
example (Fig. 2.2), assume that it is desired to transfer a 
package from Los Angeles to Boston, and that there is no 
direct route. In this case the package must be shipped 
along the lines of the road network until it arrives at 
Bos ton. 
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Table II. 2 

The Cost and Node Matrices after the First Iteration 
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Table II. 3 

The Cost and Node Matrices after the Second Iteration 
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For i - j , let = 1 mean that the package is sent 

directly from city i to city j and let = 0 mean that 

it is not. x^^ is 1 if the package comes to city i from 
some adjacent city and 0 if the package does not. If a 
route exists between two cities these cities are said to be 
connected . Under these conditions a system of constraints 
(Table II. 4) can be written. 

For example, the fourth equation in (2.8) indicates 
that the amount shipped into Boston is equal to unity. 

The last equation in (2 . 9) states that the amount shipped 
out of Los Angeles is equal to unity. 

Subject to the constraints in Table II. 4 and the fur- 
ther constraint x. . = 0 or 1 for i^j, the form 
n n 

/ / d. .X. . = z n = 20 (2.10) 

ij ij 

i=l j=l 



is minimized -- d^^ is the cost of travelling between city 
i and city j. 

The X. .'s in the constraints are unknowns and hence 
ID 

all possibilities and combinations of these equations must 
be tried. Some of the calculations are presented here: 



z = ,d_x_+ d_x_ + d_x_ ... d^^20^1,20 



11 11 "*12""12 "*13 13 

d 



'^ 21^21 ''' ^ 22^22 ^ 23^23 



X. 



21,20 2,20 



+ 



^19,1^19,1 '^19,2^19,2 '^19,3^19,3 



^19,20^19,20 



+ + d^^x^^ + d3^X3^ 

+ 



^ 20 , 1 ^ 20,1 



*^1,20^1,20 ^2,20^2,20 ^3,20 ^3,20*** ^20 , 20^20 , 20 t 
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^21 






■^^19,1 


=^11 




+X32 




■^^13,2 


^^22 


^23 


+==43 


■^^17 , 3 


=^33 




^34 


+==54 


+X74 


=1 


^45 




■"='65 


+X85+X75 ■*■^14,5 


=^55 




^56 




■^^76 


=^66 



^ 1,19 ■’■^ 18,19 ^19 



^12 




^=' 1,19 


=^11 


^21-^^23 


■"=' 2,13 




^^22 


^32 


+X 34 


+=' 3,12 


=^33 


^54 


+X36+X57+X5g 


■"='5,14 


=^55 


^19,1 


■"='19, 


18 


=^19 



20,9 +5C2q^3^5''’^20,16''’^20,19 ^ 



Table II. 4 

The Constraints of the Map in Fig. 2.2 



( 2 . 8 ) 
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(2.9) 
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After trying all possibilities of in Table (II. 4), 

the optimal case was found and is shown below. 



^44 “ ^43 ^33 ^38 ^38 ^88 ~ 



^8,18 ^18,18 ^18,16 ^16,16 ^16,20 



^16,18“ ^20,20 ^34 ^83 ^18,8 



^ 20 , 10 = ^ 



all of the other x^^'s and equal to zero. 



1 ^ 44^44 ^ 43^43 ^ 34^34 ■*■ ^ 33^33 ^ 8^38 



■^^ 83^83 ^ 88^88 ^ 8 , 18 ^ 8,18 ■*■ ^ 18 , 8 ^ 18,8 

■^^18,18^18,18 ^18,16^18,16 ‘^16,18^16,18 '^‘^16 , 16^6J.6 

‘^16,20^16,20 ■'■ ‘^20, 20^20, 20 i 

= (0x1 + 10x1 + 10x1 + 0x1 + 23x1 + 23 X 1 

0x1 + 6x1 + 6x1 + 0x1 + 12x1 + 12x1 + 0x1 

3x1 + 3x1 + 0x1) 

= 108. 

After considering that all possibilities of x^^ must 
be tried, it is seen that this method appears to be only as 
good as direct enumeration. Direct enumeration also re- 
quires that all possible paths be tried, and in Dantzig's 
algorithm this is done by substituting the appropriate 
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values of x. . into Eq. (2.10). It is concluded that the 

i: ^ 

time spent and amount of storage used in Dantzig's algo- 
rithm is excessive. 

D. DANTZIG'S GRAPHICAL ROUTING ALGORITHM 

In the same article (Ref. D-1), Dantzig presents a 
graphical approach to the algorithm already explained. By 
using graphics he makes the problem easier to visualize, 
but in no way shortens the process. All possible paths must 
be tried in order to be sure that the optimal path is found. 

First a path is chosen from the starting point, Los 
Angeles, to all of the other cities on the map (see Fig. 
2.3). These paths, indicated by arrows, are completely 
arbitrary. The routes associated with the arrows cannot 
form loops. First the distance from Los Angeles to city i 
along the path indicated by the arrows is calculated. This 
distance, or cost, is indicated by t^^ . For example, from 
Los Angeles to Chicago the distance along the route shown 
is 38 plus 8; hence t^ = 46. The next step is to find 
the optimal route from Los Angeles to all other cities. To 
do this, the numbers in the circles have to be justified 
as the shortest distances. To test whether they are mini- 
mum for each directed link of the network joining city i 
to city j, the distance d^^j is compared with t^-t^. If 
t^-tj ^ d^j for each of the links, the optimal path from 
Los Angeles to any other city has been found. 
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Fig. 2.3 Illustration of Dantzig's graphical algorithm. 
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For example, since the distance from Chicago to 

Boston is 10 compared to t^-t^ = 67-46 = 21, the arrow is 
placed between Chicago and Boston instead of between 
Washington and Boston, and t^^ is changed from 67 to 56. 

All other possible checks are made and the shortest route 
from Los Angeles to Boston includes Denver, Salt Lake City, 
Indianapolis and Chicago (see Fig, 2.4). 

Dantzig's graphical routing algorithm is much easier 
to understand, but it still has the disadvantage of being 
a trial-and-error method. It would not be advantageous to 
program this algorithm for computer use, because the number 
of calculations and logic statements is excessive when com- 
pared to dynamic programming. The number of steps in the 
calculation is dependent on the number of cities and how 

they are connected to one another. The number of steps 
n 

equals ~ 20 in this example) where m^ is the number 

of connections to city i. The number of steps in this 
algorithm is greater than the number required by dynamic 
programming . 

E. MOORE'S SHORTEST PATH THROUGH A MAZE 

By taking a different approach to the problem of 
shortest routes, Moore (Ref. M-1) has obtained some inter- 
esting results that have many practical applications. 

Among these applications are the routing of toll calls 
through trunk circuits, and the determination of shipping 
and transportation routes. 
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Fig. 2.4 The solution to the example of Dantzig's 
graphical algorithm. 



1 . Algorithm A 



In his first algorithm, Moore divides all the 
nodes, or cities, into a unity-cost spacer the costs be- 
tween each of the cities are the same, or unity, in value. 

Suppose that it is desired to find a path with the 
minimum number of intermediate cities between Los Angeles 
and Boston (Fig. 2.5). In order to carry out the algo- 
rithm, the number zero first is placed in the circle ad- 
joining Los Angeles (see Fig. 2.6). In the second step, 
the number one is written on the cities connected to Los 
Angeles - San Francisco, Denver, Nashville, and Phoenix. 

In the next step, the number two is written in the cities 
adjoining those obtained in the previous step; thus 
Seattle, Salt Lake City, Oklahoma City, Dallas, Savannah 
and New Orleans are designated with a two. In the fourth 
step, as in the previous two steps, the number three is 
written on the cities connected to those in the third step. 
The adjoining cities are Fargo, Indianapolis, Columbus and 
Miami. In the fifth step the number four is placed in all 
of the cities adjoining those in step four. In this step 
the destination, Boston, is reached because it is connect- 
ed to Columbus. Now the path must be retraced back to the 
starting point. The sixth, seventh, eighth, and ninth 
steps simply involve putting an arrow from Boston to 
Columbus, from Columbus to Dallas, from Dallas to Nashville 
and from Nashville to Los Angeles. The tenth step involves 
erasing all of the numbers not on the path itself. 
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Fig. 2.5 The network connecting several cities. 
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Fig. 2.6 The results of applying algorithm A to 
Fig. 2.5. 
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In general, if the length of the shortest path is n 
it takes 2n+2 steps if this algorithm - which will be re- 
ferred to as algorithm A - is used. On a digital computer 
the steps carried out above would be done serially with a 
few calculations for each city. 

The total amount of memory required is dependent on 
the cost of the optimal path. If n is the cost then l+log 2 n 
bits of memory are required for each city, 

2 . Algorithm B 

In algorithm A it is necessary to have a memory 
capacity capable of handling an arbitrary integer (up to 
the number of cities on a path) , Suppose that it is desir- 
ed to carry out the same problem using less memory. Moore 
suggests algorithm B, which by modulo 3 arithmetic, reduces 
the amount of memory for each node to 2 bits regardless of 
the number of cities on a path. 

At each city only the numbers 0,1, or 2 are written; 
the appropriate number is obtained by dividing the path 
length by 3 and writing the remainder in the circle for 
each city. This number can also be derived by counting 
0,1, 2,0, 1,2, etc., from the starting point until the final 
destination is reached. As the number of cities increases, 
it becomes desirable to use a modulo arithmetic with a base 
of greater magnitude. For any problem* the base of the 
modulo arithmetic can be adjusted to any number, n, as long 
as n s 3. The use of the integers of mod n depends on the 
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fact that, if the integers are calculated for any set of 
cities, each city must have an integer label which is equal 
to one less than or one more than the adjacent label. In- 
tegers of mod 3 afford this capability, whereas those of 
mod 1 and 2 do not. 

Algorithm B is carried out with the same number of 
steps and in the same way as algorithm A. The only dif- 
ference between the two is that in algorithm B integers of 
mod 3 are used instead of the normal counting numbers. An 
example is shown in Fig. (2.7). 

Algorithm B reduces the amount of computer memory 
necessary to solve the problem and takes no longer. 

3 . Algorithm C 

There is still another algorithm, called Algorithm 
C, to solve this same problem. Algorithm C uses only one 
bit of memory for each city, but requires more steps in its 
calculation. 

To use this algorithm, zeros are written in all the 
cities. A one is then written in the first city. In the 
next step, ones are written in all of the cities that are 
connected to this first city. In the next step, this same 
process is repeated. After n+1 steps — n is the number of 
cities passed through — the next group of ones requires 
that a one be placed in the destination. With a one on the 
destination, an arrow is drawn to indicate the path taken 
from the final point back to the city which the final point 
connects. Then all of the ones are erased. 
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Fig. 2.7 The results of applying algorithm B to 
Fig. 2.5. 
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In the next iteration the process is carried out in 
the same manner but with the final point changed. The 
final point for the new iteration is the city that connects 
the final point in the preceding iteration. This process 
is continued until the arrows reach the starting point. 

The following example illustrates the operation of 
the algorithm. Using the same map as in Fig. (2.5), sup- 
pose that it is desired to find the shortest route from Los 
Angeles to Boston. In the first step a one is placed in 
the circle for Los Angeles. The second step requires that 
a one be placed in the cities adjacent to Los Angeles — 

San Francisco, Denver, Nashville, and Phoenix. In the third 
step, a one is placed in the cities connected to San Fran- 
cisco, Denver, Nashville, and Phoenix; these cities are 
Seattle, Salt Lake City, Oklahoma City, Savannah, Dallas 
and New Orleans, In the fourth step, ones are placed at 
Fargo, Indianapolis, Columbus and Miami. In the (n+l)st, 
or fifth step, a one is placed at Boston and an arrow is 
drawn from Boston to Columbus (Fig. 2.8) . All of the ones 
are then erased and the process is repeated with Columbus 
as the final point. After four steps, a one is placed at 
Columbus and an arrow is drawn from Columbus to Dallas — 
which becomes the new final point for the next iteration. 

All of the ones are then erased and the process started 
over. After (n+1) + (n) + (n-1) , or 12 steps, a one is placed 
at Dallas and an arrow is drawn from Dallas to Nashville 
(Fig. 2.9). All of the ones are replaced with zeros and a 
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Fig. 2.8 The fifth step in algorithm C. 
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Fig. 2,9 The twelfth step in algorithm C. 
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one is placed at Los Angeles. A one is placed at Nashville 
and an arrow is drawn from Nashville to Los Angeles, because 
Nashville is the new final point. The optimal path is then 
from Los Angeles to Nashville, to Dallas, to Colximbus, to 
Boston — the same as determined earlier. 

Although the algorithm uses less memory, it takes 15 
steps to solve this example, compared to 10 for algorithms 
A and B. In general, the number of steps in algorithm C is 
equal to 

(n+1) + n + (n-1) + . . . 1 = (n+1) (n+2) (2.11) 

All three of Moore's algorithms take less time and 
memory than Dantzig's algorithms; Moore's algorithms are a 
much more direct approach for finding the solution. With 
Moore's three algorithms it is easy to find the right one 
if a compromise between time and memory space is necessary. 

4 . Algorithm D 

The three previous algorithms presented by Moore 
are all designed to solve the same problem. Because of the 
unity cost between two adjacent cities, algorithms A, B, 
and C are too restrictive for the vehicle-routing applica- 
tion. In communications and transportation, the least 
time elapsed, or the least distance traversed, or the least 
fuel consumed between two points is often what the problem 
requires. In Moore's fourth algorithm, he develops a pro- 
cedure which is capable of handling the different costs 
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between cities. In this algorithm, which has been labelled 
algorithm D, it is assumed that the path with the least cost 
is to be found. 

In the first step of algorithm D, the number zero is 
written on the starting city. The second step consists of 
writing the costs from the starting city on all of the 
cities that are connected to starting city. In the third 
step, the cost from the starting city is written on all the 
cities that are connected to those cities that had costs 
written on them in the second step. This cost is arrived at 
by adding the cost between the latter two cities to the cost 
placed on the city in the second step. In some cases, a 
city may be connected to the starting city and also to one 
of the cities in the second step. If this occurs, the least 
cost that has been calculated is written on the new city. 
These steps continue until all of the cities have a cost on 
them. A path is retraced from the terminal point to the 
preceding city by checking the costs at all of the adjacent 
cities. The difference between the costs of the adjacent 
city and the terminal city is calculated. The difference 
that equals the cost of the path connecting the two cities, 
indicates the optimal path between the two cities. An 
arrow is placed pointing to the adjacent city determined 
in this manner. This process continues until the arrow 
points toward the starting city. 
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For example, in Fig. (2.10) it is desired to get from 
Los Angeles to Boston with the least cost. In the first 
step, a zero is placed at Los Angeles. The second step con- 
sists of putting the costs of 16 on San Francisco, 3 on 
Denver, 8 on Nashville and 15 on Phoenix. In the third 
step, the cost associated with the cities that are adjacent 
to the cities processed in the preceding step are calculat- 
ed. Seattle and Salt Lake City are adjacent to San Fran- 
cisco and the costs to these cities from Los Angeles are 26 
and 22 respectively. From Denver to Salt Lake City the 
cost is only 15; therefore, the cost from Los Angeles to 
Salt Lake City via Denver is placed at Salt Lake City, 
because it is less than the cost from Los Angeles to Salt 
Lake City via San Francisco. The cost to Oklahoma City 
from Los Angeles via Denver is 23. The cost from Los Ange- 
les to Savannah via Nashville is 29; to Dallas the cost is 
61. The cost from Los Angeles to New Orleans via Phoenix 
is 26. This process is continued until all of the cities 
have the appropriate costs written on them. 

In order to select the path from Los Angeles, it is 
necessary first to find the difference in cost between 
Boston and the adjacent cities. By finding the difference 
that is equal to the cost along that path, an arrow can be 
placed that indicates the direction to Los Angeles. The 
difference in cost between Boston and Chicago is 10 — this 
is equal to the cost along the direct path from Boston to 
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Fig. 2.10 The results of applying algorithm D 
to Fig. 2.5. 
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Chicago; therefore, an arrow is then placed pointing to- 
ward Chicago. The difference in cost between Chicago and 
Indianapolis is 23 — this equals the cost along the path 
connecting these two cities, so an arrow is placed that 
points to Indianapolis. The optimal path continues through 
Salt Lake City and Denver to Los Angeles. 

It can be seen how this problem resembles the method 
of dynamic programming. If the problem is to be put into 
matrix form, one row of the matrix would be solved for. It 
would be necessary to start at each of the cities and solve 
for the optimal costs to all of the other cities. 

There is an equal number of steps in using algorithms 
A and D, (2n+2) — where n is the number of intermediate 
cities. The storage requirements of algorithm D are great- 
er because of the larger numbers used, but algorithm D, 
being more general, includes algorithm A as a special case. 
By taking a different approach than Dantzig, Moore has been 
able to dispose of much of the trial-and-error in Dantzig 's 
algori thms . 

F. LEE'S ROUTING ALGORITHM 

C. Y. Lee (Ref. L-1) has developed an algorithm in 
which the cost is defined as the sum of the number of ob- 
stacles crossed and the number of intermediate cities. Lee 
states that his algorithm is a modification of Moore's algo- 
rithm A. Lee uses a cost of unity between all the points 
as Moore did. In his algorithm, Lee does add an additional 
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cost for crossing obstacles; however his algorithm works 
in the same manner as Moore's algorithm A. In going from 
one node to the next, the process is the same except that 
instead of simply counting the number of intermediate cities, 
the algorithm also keeps track of the number of times that 
an obstacle is crossed. These two costs are added to de- 
termine the final cost at each city. 

In Fig. (2.11) three obstacles are shown on the map. 
Assume that it is again desired to travel from Los Angeles 
to Boston with the least cost. In the first step the num- 
bers (0,0) are placed on Los Angeles. The first number in 
the expression is the distance travelled from Los Angeles, 
and the second niimber is the number of obstacle crossings 
on the path from Los Angeles to the current city. In the 
second step, all of the adjacent cities' costs are calcula- 
ted; (1,0) is placed on San Francisco, (1,0) on Denver, 

(1.2) on Nashville, and (1,0) on Phoenix. The third step 
consists of putting (2,0) on Seattle, (2,1) on Salt Lake 
City, (2,2) on Oklahoma City, (2,2) on Savannah, (2,3) on 
Dallas, and (2,1) on New Orleans. The fourth step is to 
put a (3,0) on Fargo, (3,2) on Indianapolis, (3,1) on 
Dallas — which replaces the (2,3) from the last step 
because 3+1 = 4 is less than 2+3 = 5, (3,1) at Miami, and 

(3.3) on Washington. The process continues until Boston is 
reached. The arrows are placed on the optimal path by re- 
tracing the steps taken to reach Boston. 
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Fig. 2.11 The results of an application of Lee's 
algorithm. 
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Lee's algorithm has the same advantages as Moore's 
algorithm A and the added factor that it allows additional 
costs to be placed on a path. There is a price to pay for 
this added convenience, however; Lee's algorithm requires 
storage for two numbers as opposed to Moore's algorithm 
which has only one number for each of the cities. 

G. SUMMARY 

By comparing these algorithms it is found that each has 
its good and bad points. It seems that Dantzig's algorithms 
have little practical use because there are so many steps 
involved as well as large memory requirements. 

The algorithms of Moore and Lee are very similar, but 
in comparison to Dantzig's algorithm they are more efficient. 
Because of this, the number of steps required is consider- 
ably less than in either Dantzig's algorithms or in direct 
enumeration, and the storage requirements are reduced. 

There is great similarity between Moore's algorithm D 
and dynamic programming. The methods are different but the 
effect turns out to be the same. Dynamic programming is a 
more direct approach to the solution when a large number of 
points are involved. 
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III. 



LIM'S PATH-FINDING ALGORI THM 



AND ITS SIMULATION 



A. INTRODUCTION 

The algorithms already discussed assume that suffi- 
cient knowledge is available about the terrain and its 
features to obtain a cost matrix. Because of the lack of 
such knowledge in planetary exploration, a path-finding 
algorithm which uses only local sensor information has been 
developed by L. Y. Lim of the Jet Propulsion Laboratory 
(Ref. L-2) . Given an initial point and a terminal point, 
the algorithm can find its way around obstacles whose size 
and extent are unknown. The path generated by the algo- 
rithm, however, may not always be the most efficient in 
terms of the total distance travelled, or time spent. By 
using one of the algorithms presented earlier, an optimal 
path can be obtained from the knowledge that is available 
from reconnaissance photographs. The robot follows this 
optimal path until it senses an obstacle from the local 
sensor information. With the local sensor information and 
Lim's path-finding algorithm, the robot finds its way 
around the obstacle and returns to the pre-determined op- 
timal path. 

Of the routing algorithms discussed earlier, dynamic 
programming seems to be the one best suited for this ap- 
plication. The speed and ease of calculation for a large 
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number of points makes it superior to the other algorithms. 
The dynamic programming algorithm has been programmed by 
Dr. D. E. Kirk in Fortran IV for operation on the IBM 7094 
digital computer (see K-2) . This program was converted for 
use on the IBM 360/67. 

B. LIM'S PATH-FINDING ALGORITHM 

Lim's path-finding algorithm assumes that: 

1. all of the obstacles within the scanning range are 
de tec ted ; 

2. initial and terminal points are given; and 

3. the robot cannot pass over a predetermined eleva- 
tion as a contour limit. 

Lim's algorithm is designed to meet the following re- 
quirements: 

1. if a path exists the algorithm can find it; 

2. the algorithm navigates around all hazards; and 

3. the algorithm uses a minimal number of memory 
locations. 

Lim's path-finding algorithm consists of three parts, 
the main, left-scan, and right-scan algorithms. The main 
algorithm directs the robot straight ahead, or to the 
right or left. The right-scan takes the robot only to the 
right around an obstacle. The left-scan takes the robot 
only to the left around an obstacle. The right and left- 
scans enable the vehicle to navigate out of a box canyon 
or around other obstacles. 
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1 . The Main Algorithm 



a. Initially a vector is constructed from the 
starting point (X^,Y^) to the target point (Xj_,Yj_) . The 
azimuth of the vector, denoted by 9, is then determined. 

b. The next point of travel (X,Y) is 



X = X + r cos 0 
o 

(3.1) 

Y = Y + r sin 6 
o 



where r is the scanning range of the local sensors. 

c. The point given in Eq. (3.1) is evaluated to 
see if it satisfies 



F(X,Y) ^ CONTOUR LIMIT (3.2) 

where F(X,Y) is the elevation at (X,Y) . If the inequality 
(3.2) is satisfied, then the algorithm goes to step e; if 
not, the algorithm proceeds to step d. 

d. If the point (X,Y) exceeds the contour limit, 
the algorithm scans to the left and right in one-degree in- 
crements (i.e., 0 ± 1 degree, 6 = ± 2 degrees, etc.) until 
an acceptable contour limit is found. If none is found, 
the vehicle is trapped and there is no way out; this con- 
dition can occur only at the starting point. The scanning 
process is: 1 degree to the left of 0, 1 degree to the 
right of 0, 2 degrees to the left of 0, 2 degrees to the 
right of 0, etc. 



54 



e. If the elevation F(X,Y) is within the contour 
limit at step c, it is necessary to determine if the ter- 
minal point has been reached. If the terminal point has 
been reached, then the job is finished; if not, (X^,Y^) , 

which is the point before (X ,Y ), is replaced with (X ,Y ) 
^ o o o o 

and (X^,Y^), is replaced with (X,Y) . If 



X = X + r cos 0 
Y = Y + r sin 0 



( 3 . 3 ) 



is acceptable, then the right and left counters are set to 
zero. If the point (X,Y) is found to be acceptable by de- 
flecting to the right, then the right counter is set to 
one. If an acceptable point is found by deflecting to the 
left, then the left counter is set to one. If the point 
(X,Y) is found by deflecting to the left or right, then the 
distance to the target is calculated and stored as D^. If 
both counters are not equal to one, then the algorithm re- 
turns to step a. If both counters are equal to one, the 
distance from the right point is compared with the distance 
from the left point. The distance which is the smaller 
determines whether the main algorithm goes into the left or 
right-scan algorithm. 

2 . The Left-Scan Algorithm 

Because of the similarity between the left and 
right-scan algorithms only the left scan will be discussed. 
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a. Upon entering the left-scan, a target vector is 
constructed by using (X^,Y^) and (X^,Y^) . A crawling vec- 
tor is also constructed using 

azimuth of the target vector and the crawling vector are 
then found. The crawling vector azimuth is called 6l . 

The distance from (X,Y) to (X^,Y^) at the time of detect- 
ing the obstacle is 

b. The next point of travel (X,Y) is 

X = X^ + r cos (01 - 90°) 

(3.4) 

Y = Y + r sin(01 - 90°) 
o 

where r and 01 are defined as before. An evaluation of the 
elevation F(X,Y) is then made. If F(X,Y) is not within the 
contour limit, then 01 is incremented by one degree inter- 
vals until an acceptable contour limit is found. Once an 
acceptable contour limit is found, the distance to the 
target is calculated by using (X,Y) and (X^,Y^.) . This 
distance is set equal to D. . If is not less than D,,^„ 

then the algorithm returns to step a of the left scan 

algorithm. If D. is less than then the contour 

^ t MIN 

value F(X,Y), where 



X = X + r cos 0 
o 

Y = Y + r sin 0 
o 



is evaluated. 



(3.5) 
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If F(X,Y) is greater than the contour limit, the algo- 
rithm returns to step (1) of the left-scan algorithm. If 
F(X,Y) is less than the contour limit, the algorithm resets 
the left and right counters to zero and the algorithm re- 
turns to the main section. 



C. DEVELOPMENT OF TERRAIN SIMULATION AND CONTOUR MAPPING 

With the introduction of a path-finding algorithm it 
is necessary to test the algorithm on simulated terrain. 
Since the simulation is to be topographical, it must have 
various levels. The simulation was performed by using 
Gaussian density functions to represent the hills and moun- 
tain ranges that would be found by photoreconnaissance of 
the actual planet. The elevation at a point of the terrain 
is found simply by summing the Gaussian density functions. 

Two different types of equations using Gaussian den- 
sity functions were developed in order to simulate the dif- 
ferent shapes of mountains. Mountains were assumed to be 
either circular or elliptical. The equation used to simu- 
late mountains of the circular type (Fig. 3.1) was: 



CONTOUR = HEIGHT * EXP(-1.((X - X ) /a ) ) 

o ^ 



+ ((Y - Y^)/C^)^) ; 



(3.6) 



where CONTOUR is the height of the mountain at (X,Y) . 
(X^,Y^) is the coordinate of the center of the circular 
mountain; 
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Fig. 3.1 Contour map of a circular hill 
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Height is the height at the center point ’ 

(7 is the standard deviation in the X direction; and 
is the standard deviation in the Y direction, and 
equals for the circular case. 

The equation used to simulate the mountain with an 
elliptical contour as shown in Fig. (3.2) is: 

CONTOUR = HEIGHT * EXP(-1.((((X - X^) cos (ALPHA) 

+ (Y-Y ) sin (ALPHA) )/ ct„) ^+( (- 1. (X-X ) sin (ALPHA) 

O A. O 

+ (Y-Y^) cos (ALPHA) )/(Ty)^)) . (3.7) 

Where ALPHA is the angle from the X axis to the semi-major 
axis of the ellipse. By varying the sigmas, the height, 
and the angle ALPHA, it is possible to simulate a variety 
of terrain features. 

Table (III . 1) gives some typical mountain heights ob- 
served on lunar charts. The mountains are generally cir- 
cular in nature. The craters are due in part to volcanic 
action as well as meteors crashing into its surface. These 
craters were simulated by adding two Gaussian functions to- 
gether. One hill — the larger of the two — was added to 
a hill with a negative height. The radii were, as indicated 
in Table (III.l), simulated by setting the sigmas equal to 
the radius divided by 2.5. 

In order to roughen the terrain, an additional feature 
was included to create obstacles on the terrain map. Two 
different formulations were contrived, one for the circular 
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Fig. 3.2 Contour map of an elliptical hill. 
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mountain and another for the elliptical mountain. The 
number of obstacles was assumed to be three times the 
height of the mountain. It was natural that the obsta- 
cles would be placed at irregular intervals and that they 
would vary in size. 

In the case of the circular mountain, an imaginary 
set of axes was drawn through (X^,Y^) parallel to the north 
and east axes of the grid. The position angle of the ob- 
stacle was determined by a uniform-distribution random num- 
ber generator. Once the angle had been determined, the 
position on this vector is based on a Gaussian distribution 
with its mean equal to the radius of the hill. It was as- 
sumed that there is debris from the top of the mountain to 
a distance of two times the radius of the mountain. This 
means that the sigma of the Gaussian distribution is equal 
to the sigma of the mountain. In keeping with the rest of 
the terrain simulation, the obstacle was assumed to be a 
circular Gahssian hill with a radius equal to the height of 
the obstacle. This meant that the sigma of the obstacle 
is equal to the obstacle height divided by 2.5. The height 
of the obstacle was determined by assviming that the larger 
the obstacle, the farther it would roll. The maximum ob- 
stacle height is assumed to be one one-hundredth of the 
height of the mountain. As stated earlier, the obstacles 
are assumed to be confined to within a radial distance of 
two times the radius of the mountain. Under these condi- 
tions the equation 
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Name 



Height in Meters 



Radius in Meters 



Encke y 


930 


3100 


Encke or 


720 


2200 


Maestlin 4 


810 


3200 


Kepler 


700 


3200 


Flams teed 


1670 


42000 


Encke B 


1100 


600 


Bessarion 


900 


1000 


Marius A 


2000 


40000 


Tobias Mayer C 


420 


2800 


Mickhius ^ 


750 


4000 


Unknown 


1020 


4100 


Unknown 


690 


3800 


Unknown 


1010 


5000 


Marius D 


100 


900 



Table III.l 

Dimensions of Some Lunar Mountains 
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(3.8) 



H 

H = ^ * D 

1 100*2R 1 

was obtained. 

is the height of the obstacle; 
is the height of the mountain; 

R is the radius of the mountain; and 

is the distance of the obstacle from the center of 
the mountain as determined by the Gaussian distribution. 

The results of this theory are shown in Fig. (3.3). 

The formulation for the placement of debris about the 
elliptical mountains was done in a similar manner as that 
for circular hills. Because the hill is not symmetric, 
large amounts of mass were assumed to lie along the semi- 
major axis. Since the majority of the mass has moved along 
the semi-major axis, it is reasonable to assume that the 
debris created by this mass movement will be in this direc- 
tion. 

The total number of obstacles was again selected as 
being equal to three times the height of the mountain. A 
set of imaginary axes was drawn to coincide with the semi- 
major and semi-minor axes of the ellipse. It was assumed 
that was greater than in some cases this requires 

the X and Y axes to be completely independent of the north 
and east axes of the grid. The angle BETA, as indicated 
in Fig. (3.4) was determined by the arc tan of The 

other lines defining the four segments were found by 
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Fig. 3.3 Distribution of obstacles around a circular hill. 
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< 




Fig. 3.4 The sections of an elliptical hill 
used in determining the disposition 
of debris. 
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adding 180 degrees and subtracting 360 degrees from BETA. 
Once the ellipse had been divided in this manner, the num- 
ber of obstacles in each segment was determined. Segments 
one and three contained the largest number of obstacles. 

Each segment was divided into sixteen equal sections with 
the number of obstacles in each section being equal for a 
given segment. Sixteen separate radii were calculated by- 
taking the difference between the longest and shortest 
radii of the ellipse and dividing by sixteen. The sixteen 
radii were used as the means of Gaussian distributions 
which determine the obstacle's coordinates along the posi- 
tion vector. The sigma of the Gaussian distribution was 
equal to the radius of the mountain divided by 2.5. The 
position vector was generated from a random number genera- 
tor which provided a uniform distribution within each of the 
sections. The Gaussian distribution along the position vec- 
tor determined the distance from the center of the hill. 

The height of the obstacle was determined by Eq. (3.8) and 
the sigma of the obstacle equaled the height divided by 
2.5. The results of this theory of positioning the obsta- 
cles are shown in Fig. (3.5). 

D. SIMULATION OF LIM’S PATH-FINDING ALGORITHM 

Lim's path-finding algorithm has been programmed in 
Fortran IV language for the IBM 7090/94 IBJOB System. 

Before the algorithm could be applied, a suitable terrain 
simulation had to be generated. Five Gaussian hills were 
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Fig. 3.5 Distribution of obstacles around an elliptical hill. 
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used and the obstacles were generated around each of them 
by using the procedure described in the previous section. 

The contour plotting package, written by Dr. M.O. Dayhoff 
(Ref. D-2) , shows only the elevations generated by the 
Gaussian hills. The heights of the obstacles were not in- 
cluded because of the large number of calculations and the 
long computer times. 

The next step in preparation for running Lim's algo- 
rithm was to use the dynamic programming algorithm to find 
the optimal paths. The map was divided into 81 grid points 
that were equally spaced 2500 meters apart. The cost ma- 
trix used in the dynamic programming algorithm was the ac- 
tual distance travelled by the vehicle over a three-dimen- 
sional Euclidean surface. The node matrix was calculated 
and used in determining the optimal path for Lim's algorithm. 
In the first attempts to use Lim's algorithm the elevation 
limit proved to be too restrictive and the route wandered 
too far from the optimal path given by dynamic programming. 

The first corrective action was to change the eleva- 
tion limitation to a slope limitation. A slope of 11 de- 
grees proved to be satisfactory for later simulations. 
Although the slope limitation allowed greater maneuver- 
ability for the algorithm, one big disadvantage became ap- 
parent. It was more difficult to see why the algorithm 
reacted as it did to certain situations. With the slope 
limitation, it was impossible to draw a wall around an 
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obstacle as could be done with the elevation limit. To 
alleviate this difficulty, a factor was added to the sec- 
tion of the dynamic programming algorithm that calculates 
the cost matrix from the simulated terrain. Every time a 
path crossed a slope limitation, the cost for that path was 
multiplied by this factor. This factor was tried at two 
different values. The first of these was 2.0, which means 
that the robot would go twice as far to avoid a slope limi- 
tation. Because the factor was small, the paths calculated 
by the dynamic programming algorithm went over the slope 
limitation. In simulations one and two, the number of 
points used in the dynamic programming algorithm were re- 
duced to sixteen with intervals of 6666.67 meters between 
nodes. This reduction was due to the fact that with 81 
points on the grid the length of computer time was excess- 
ive . 

In Fig. (3.6), the nominal path calculated by dynamic 
programming crosses a hill which surpasses the slope limi- 
tation. The algorithm was unable to follow the nominal 
path and had to calculate its own path around the hill. 

The contour of the hill forced the algorithm to make such 
a large deviation from the nominal path. 

In Insert B of Fig. (3.6) the algorithm performed a 
switchback movement. In Lim's original algorithm this was 
not possible because the test to get out of the right or 
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left scan mode not only required that the distance to the 
target be less than but also that the point (X,Y) had 

to be 



X = X + r cos 6 
o 

(3.9) 

Y = Y + r sin 0 . 
o 



Frequently, a point was found such that the distance to the 
target was less than but the point (X,Y) was beyond 

the slope limitation and failed to meet the second require- 
ment to get out of the scan algorithm. As a result, the 
algorithm would continue around the same obstacle until it 
came back to the same point where the distance to the target 
was less than - At this point the same calculations 

would re-occur and the algorithm would continue around in- 
definitely. By eliminating the requirement that (X,Y) be 
generated as given in Eq. (3.9) the algorithm was able to 
move to the next obstacle and proceed around it in the 
usual fashion. 

Fig. (3.7) and Inserts A and B of Fig. (3.7) show the 
results of simulation run one with the obstacles; the robot 
went around them in excellent fashion. By comparing Fig. 
(3.7) and Inserts A and B of Fig. (3.7) with Fig. (3.6) and 
Inserts A and B of Fig. (3.6) it is seen that there is 
little variation in the two paths. This shows that the 
amount of deviation from the optimal path is dependent on 
the size and slope of the obstacle on the path. 
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Fig. 3.6 Simulation one without the obstacles. 




Insert A of Fig. 3.6 Simulation one without the obstacles. 
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Insert B of Pig. 3.6 Simulation one without the obstacles. 



73 




Fig. 3.7 Simulation one with the obstacles. 
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Insert A of Fig. 3.7 Simulation one with the obstacles 
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In simulation two (Fig. 3.8) there is no difference 
in the simulations with and without the obstacles which in- 
dicates that although there are obstacles, none lies on the 
optimal path. This run, like simulation one, deviated from 
the optimal path because the dynamic programming algorithm 
again chose a path which crossed the slope limitation. 
Another interesting feature did come up, and can be seen in 
Insert A of Fig. (3.8) in the small box. The algorithm had 
taken a route that went in circles until it found a satis- 
factory point that would allow it to leave the left-scan 
algorithm. The difficulty is due to the 90 degree factor 
present in the equation 



X = + r sin(6l ± 90°) 

Y = Y + r cos (01 ± 90°) 



(3.10) 



when in the scan mode. With the 90 degree factor added in 
Eq. (3.10), the algorithm would often continue in circles 
indefinitely. With the 90 degrees reduced to 45 degrees, 
the algorithm never continued in circles indefinitely and 
the algorithm went in circles less frequently. 

In simulations three and four (Figs. 3.9 and 3.10) a 
small square 400 meters by 400 meters was taken out of 
the center of the map. .The dynamic programming algorithm 
was run for 81 points, 50 meters apart. A cost factor of 
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Fig. 3.8 Simulation two. 




Insert A of Fig. 3.8 Simulation two. 
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2.0 was used in determining the cost matrix. The paths 
selected by the dynamic programming algorithm went over 
the slope limitation because the cost factor was small. 

In simulation three (Insert A of Fig. 3.9) when the 
algorithm was about to reach the intermediate node B given 
by the dynamic programming solution, the algorithm hit a 
slope limitation and took a long and devious path to get 
back to node B. When the robot is so close to the node 
point a provision should be incorporated to allow it to go 
to the next node, because the purpose of the algorithm is 
to reach the final destination. The intermediate nodes are 
only to direct the algorithm along a nominal path. 

As the algorithm was progressing towards node F it en- 
countered a slope limitation that could not be crossed 

. ' ‘ ■s • , 

without going out to po^int Z (Fig. „3-9) . This occurrence 
can only be explained by the fact that the slope of the 
hill caused the algorithm to take this path. 

In simulation four the path chosen by the dynamic 
programming algorithm crossed the slope limitation for a 
short distance from the initial point; hence the algo- 
rithm stayed close to the nominal path. 

In simulations five through eight, the cost of going 
over a slope limitation was increased to 1000 when the 
dynamic programming algorithm was executed. With this 
high cost any path that crossed a slope limitation was 
not chosen as a nominal path. In simulations seven and 
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Fig. 3.9 Simulation three. 
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Insert A of Fig. 3.9 Simulation three. 
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Fig. 3.10 Simulation four. 
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eight, 81 nodes were used (as in simulation three and four) . 
All the simulations showed good results both in getting to 
the target point and in detecting and going around obstacles 

In Insert A of Fig. (3.11) a small obstacle was encounter 
ed, but, as can be seen, the path-finding algorithm made 
only a slight deviation from the nominal path. Insert B of 
Fig. (3.11) shows how the algorithm went to the right around 
an obstacle and returned itself to the optimal path. 

Insert A of Fig. (3.13) shows that an obstacle was de- 
tected, and how the algorithm took the robot around the ob- 
stacle. Insert B of Fig. (3.13) shows how the robot went 
around an obstacle but did not return to the optimal path. 
Instead the algorithm took a straight-line path to the 
target. The same feature occurred in Insert C of Fig. 

(3.13). This feature of following a straight-line path to 
the target after the robot has gone around an obstacle may 
seem to be a good idea, but once the robot starts calcula- 
ting its own path over a long distance the purpose of using 
dynamic programming has been defeated. Inserts D and E of 
Fig. (3.13) show how the robot went around the obstacle and 
returned to the optimal path. 

In simulations seven and eight (Figs. 3.14 and 3.15) 
a devious route was calculated by the dynamic programming 
algorithm. Both simulations stayed on the nominal path 
even with the obstacles placed around the hill. This in- 
dicates that even though there were obstacles, none were 
on the nominal path. 
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Fig. 3.11 Simulation five. 




Insert A of Fig. 3.11 IlliBtrating the path taken around 

an obstacle. 
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Insert B of Fig. 3.11 Illustrating the path taken around 

an obstacle. 
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Fig. 3.12 Simulation six without the obstacles. 
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Fig. 




3.13 Simulation six with the obstacles. 
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Insert A of Fig. 3.13 Illustrating the path taken around 

an obstacle. 
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Insert B of Fig. 3.13 Illustrating the path taken around 

an obstacle. 
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Insert C of Fig. 3.13 Illustrating the path taken around 

an obstacle. 
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Insert D of Fig. 3.13 Illustrating the path taken around 

an obstacle. 
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Insert E of Pig. 3,13 Illustrating the path taken 

around an obstacle. 
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Fig. 3.14 Simulation seven. 
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Fig. 3.15 Simulation eight* 
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III. SUMMARY AND CONCLUSIONS 



A . SUMMARY 

Chapter II reported on a survey that was undertaken to 
find a routing algorithm that was best suited for determin- 
ing the optimal path over a large number of nodes. The sur- 
vey showed that dynamic programming and Moore's algorithm D 
were best suited for use as the global routing algorithm. 
Dynamic programming was chosen because it was more adaptive 
to computer use and also a program by Dr. D. E. Kirk (Ref. 
K-2) was already available. 

Moore's algorithms A,B, and C were much too restric- 
tive because of the unity cost space; however, his algo- 
rithm D could prove to be very useful in the present appli- 
cation. Algorithm D is similar to dynamic programming, but 
because of the difficulty in adapting it to computer use it 
was not used. Lee's algorithm is similar to Moore's algo- 
rithm A, but even the added feature of including the second 
cost factor proved to be too restrictive for the present 
application . 

Dantzig's algorithms proved to be of little value 
because of the many calculations required. Both algorithms 
were better than direct enumeration only because they al- 
lowed the topography of the map to eliminate those points 
that were not connected. 
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In Chapter III, Lim's path-finding algorithm was in- 
troduced. In order to show the usefulness of Lim's algo- 
rithm a suitable terrain simulation was developed. With 
the use of two different shapes of hills a variety of 
terrain features could be simulated. The disposition of 
the debris around the hills was successful in illustrating 
the performance of Lim's algorithm. Just how realistic 
the simulation of the debris is cannot be seen at the pre- 
sent time because no comparisons with actual data have been 
made. 

Because of the elevation limitation Lim's original 
algorithm restricted the vehicle to too small an area of 
exploration. After changing the elevation limit to a slope 
limitation, the vehicle was given greater versatility and 
maneuverability. The other problems associated with the 
change to a slope limitation were solved. 

B. CONCLUSIONS 

The combination of dynamic programming and Lim's algo- 
rithm provides an efficient method of maneuvering an un- 
manned robot over terrain whose topographical features are 
only partially known. The simulations illustrated this 
fact satisfactorily. It is concluded that except for some 
minor difficulties, the algorithms are well suited for use 
with an unmanned robot. 

The combined algorithm may be improved by making it an 
adaptive learning process by recording significant data. 
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e.g., true length/expected length, or mean path length 
between obstacles. At the end of each exploration this 
data could be used to re-calculate the optimal paths and 
to up-date the cost figures for all types of terrains that 
are of a similar nature. 
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